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PASSIVE POSITIONING SENSORS 



BACKGROUND OF THE INVENTION 

[001] The invention relates generally to methods and apparatus for positioning or determining 
the position of an object by optical analysis. 

[002] Global positioning satellite (GPS) technology has become popular as a means for 
positioning. For example, GPS technology can be used by a pilot to find the position of his 
vessel at sea. Such positioning information can then be used for navigation, tracking, surveying, 
and locating functions. For example, the position of the vessel can be used to assist with tasks 
such as planning a future course, tracking other vessels, and locating or surveying underwater 
phenomenon. GPS systems are even offered in many automobiles to assist drivers with finding 
their way. 

[003] These GPS systems find a position by triangulation from satellites. A group of satellites 
provide radio signals which are received by a receiver and used to measure the distance between 
the receiver and the satellites based on the travel time of the radio signals. The location of the 
receiver is calculated using the distance information and the position of the satellites in space. 
After correcting for errors such as delays caused by the atmosphere, GPS systems can provide 
positioning data within about 16 meters. 

[004] Unfortunately, GPS technology has certain limitations. One of the difficulties with GPS 
systems is that they rely on receiving signals from satellites position in orbit. Obstructions can 
diminish, disrupt or even block the signals. For example, when a GPS unit is positioned in the 
shadow of a large building the number of satellite signals can be reduced, or even worse, the 
surrounding structures can completely block all satellite signals. Natural phenomenon, such as 
cloud cover and charged particles in the ionosphere can also reduce the effectiveness of GPS 
systems. In addition, some positioning tasks require greater accuracy than GPS technology can 
provide. 

[005] Other positioning systems include the use of local radio beacons which operate on similar 
principles to the GPS system, and laser positioning systems. Unfortunately, these systems rely 
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on specialized and costly apparatus, and may also require careful synchronization and 
calibration. 

[006] As a result, there is a need for a simple and robust local positioning system which does 
not rely on orbiting satellites or local radio beacons, and which can provide increased positioning 
accuracy when needed. 



Atty. Docket No. 101328-181 



SUMMARY OF THE INVENTION 

[007] The present invention provides object positioning and attitude estimation systems based 
on an reference source, e.g., a grating assembly which generates a fringe interference pattern. 
The invention further includes a viewer, mountable on an object, for capturing an image of the 
fringe pattern. A processor can analyze the detected fringe pattern and, based thereon, the 
orientation of the object relative to the reference location is determined. 

[008] In one aspect of the invention, a method for determining position relative to an 
interference pattem generator is disclosed comprising capturing an image of an interference 
pattem from a known fringe pattem generator with a viewer and determining the phase of the 
interference pattem. Changes in phase information is then used to find the direction of the 
viewer's position relative to the fringe pattem generator. The distance to the plane supporting 
the fringe pattem generator is determined based on the number of fringes in the interference 
pattem. Based on this distance and orientation information, position data relative to the fringe 
pattem generator can be determined. 

[009] In another aspect of the invention, any integer ambiguity is resolved by tracking the 
phase of the interference pattem as the viewer changes in position relative to the fringe pattem 
generator. For each of the multiple phases captured by the viewer, the processor determines 
relative position data. Impossible or unlikely position data can then be removed. This position 
information can also be verified with information obtained from the geometry of the fringe 
pattem generator. For example, lights, reflectors, colored surfaces or other optical markers can 
be used to define a border or other predefined shape for acqusition of basic distance and/or 
orientation information. 

[0010] In yet another aspect of the invention, position data is determined using the geometrical 
features of the fringe pattem generator. In one embodiment, projective geometry provides low- 
resolution position data based on the known geometry of the fringe pattem generator and the 
geometry of the fringe pattem generator in an image captured by the viewer. This position data 
is then combined with position data based on the fringe interference patterns to find high- 
resolution position data. 
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[0011] The geometrical features of the fringe pattern generator can also be used with a feature 
extraction algorithm to recover or reorient, e.g., to rectify, the image of the fringe pattem 
generator. The resulting image can then be analyzed to extract normalized data, thus simplifying 
position analyses. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

[0012] The invention will be more fully understood from the following detailed description 
taken in conjunction with the accompanying drawings: 

[0013] FIG. 1 is a schematic perspective view an interference pattern generator which can be 
used with the device of the present invention; 

[0014] FIG. lA is a side view of the interference pattern generator of FIG. 1; 

[0015] FIG. 2 illustrates a grating assembly which can be used with the interference pattern 
generator of the present invention; 

[0016] FIG. 2A illustrates another grating assembly which can be used with the interference 
pattem generator of the present invention; 

[0017] FIG. 2B illustrates another grating assembly which can be used with the interference 
pattem generator of the present invention; 

[0018] FIG. 3 illustrates another embodiment of the grating assembly of the present invention; 

[0019] FIG. 3B illustrates another embodiment of the grating assembly of the present invention; 

[0020] FIG. 4A illustrates one embodiment of the system of the present invention; 

[0021] FIG. 4b illustrates the system of FIG. 4A arranged in a different position; 

[0022] FIG. 5 illustrates another embodiment of the system of the present invention; 

[0023] FIG. 6 illustrates spatial geometry calculations which can be used with one embodiment 
of the present invention; 

[0024] FIG. 7 illustrates a top view of the embodiment shown in FIG. 6; and 
[0025] FIG. 8 illustrates a side view of the embodiment shown in FIG. 6. 
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DETAILED DESCRIPTION OF THE INVENTION 

[0026] The present invention provides positioning systems and methods for determining a 
position in space, such as the location of an object. The system preferably includes a fringe 
interference pattern generator, a viewer for capturing an image of the fringe patterns (also known 
as "Moire pattems"), and a processor for determine position based on the information gathered 
by the viewer. The processor can derive position data based on phase information gathered from 
the fringe patterns, as well as, position data based on the geometry of the fringe interference 
pattern generator. 

[0027] Unlike prior art positioning systems which rely on signals from distant transmitters, the 
present invention allows a user to determine position with only a fringe interference pattern 
generator, a viewer, and a processor. For example, the system can be used inside a laboratory or 
warehouse where GPS measurements would be unavailable because the buildings block satellite 
signals. In addition, the system is easy to set up, can provide highly accurate positioning data, is 
inexpensive to operate, and is insensitive to electromagnetic interference. The present invention 
therefore provides a simple and robust positioning system that can assist with navigating, 
docking, tracking, measuring, and a variety of other positioning related fimctions. 

[0028] The system includes a fringe interference pattem generator, such as grating assembly 10 
illustrated in FIGS. 1 and 1 A. As shown, the grating assembly includes two parallel gratings 
12a, 12b, which are preferably flat, and can be fixed a predetermined distance from one another. 
A person skilled in the art will appreciate that a variety of grating shapes can produce 
recognizable fringe interference patterns such as rectangular, circular, triangular, and irregular 
gratings. Although parallel gratings are the preferred source of fringe interference patterns, any 
interference pattem source capable of producing a recognizable interference pattem which 
changes with the viewpoint of the viewer can be used. The pattem generators can be entirely, or 
partially, passive insofar as only illumination by the viewer or ambient light is needed to 
generate the fringe pattem. 

[0029] The characteristics of the interference pattem depend on the characteristics of the gratings 
used to generate the pattem. For example, the periodicity of the interference fringes, which is 
the distance between fringes, depends on the spacing of the gratings and the distance between the 
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gratings. If the two gratings are regular and identical, periodicity can be calculated by P = YOJd, 
where the variable h represents the distance from the viewer to the gratings, X is the characteristic 
wavelength of the gratings, and d is the distance separating the two gratings. P is the geometrical 
distance between two consecutive fringes. X is usually the mesh size of the gratings as shown in 
FIG. 2. By changing these variables, the interference pattem seen by the viewer can be changed. 

[0030] FIG. 2 also illustrates the use of one or more aUgnment markers 13 which can assist in 
angular estimation and/or distance measurements. Four markers 13, e.g., LEDs or other light 
emitters or reflectors, define the border of the grating assembly. As discussed further below, 
determining the position of fi-inge pattem generator borders (typically as a trapezoidal image) 
can provide initial estimates of height, distance and/or angular orientation. 

[0031] In FIG. 2A, another grating 12 is shown for generating a one-dimensional interference 
fringe pattem. Such one-dimensional systems are useful where the height of viewer/object is 
known and/or the object is operating on a flat surface (such as a warehouse floor). FIG. 2B 
illustrates yet another grating pattem in which the grating 12 is circular. The system of FIG. 2B 
is particularly useful in obtaining rotational information. 

[0032] The periodicity of the gratings 12 are preferably matched to the scale and accuracy of the 
desired measurement. For measuring positions over a large area or where accuracy is less of a 
concern, a larger periodicity is preferred. Conversely, a smaller periodicity is preferred for 
smaller areas or for increased accuracy. In one embodiment, the fringe pattem generator can 
produce both large and small fringe interference patterns with gratings of varying mesh size. 
FIG. 3 illustrates one embodiment of a fiinge pattem generator with two mesh sizes. The larger 
grating is defined by a mesh size X, and the smaller gratings, optionally positioned within the 
larger grating, is defined by a mesh size ofX\ In use, the fringe pattem produced by the larger 
grating can provide rough position data, and when necessary, analysis of the fringe patterns 
produced by the smaller gratings can provide refined position data. For example, if the system 
were used with a vehicle traveling toward the gratings, the larger gratings could be used from a 
distance and the smaller gratings from up close. 

[0033] In another embodiment shown in FIG. 3B, the fringe pattem interference generator 10 
can have two gratings 12a, 12b each having different mesh sizes X. Adjusting the mesh size of 
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one grating with respect to the other grating amplifies or reduces the speed at which the fringe 
pattern changes with relative movement between the fringe pattern generator and the viewer. 
For example, by increasing the mesh density of the grating closer to the viewer (e.g., positioning 
grating 12a as the upper grating) relative to the grating further from the viewer, the speed at 
which the fiinge pattern image changes can be increased. This may be desirable for measuring 
small movements and/or where the viewer and fringe pattern generator operate in a fixed plane. 

[0034] The grating assemblies of the present invention can be illuminated in various ways. In 
one embodiment, ambient light illuminates the grating assembly and creates the interference 
pattern. Alternatively, the gratings may be backlit to make the interference fringes more distinct. 
The Ught chosen for illumination may be of any wavelength which can be acquired by the viewer 
of present invention, including visible light. Exemplary sources of radiation include visible, 
ultraviolet and infrared light. More generally, any electromagnetic radiation source capable of 
generating an interference fringe pattem can be employed. The term "light" as used herein is 
intended to encompass any such electromagnetic radiation. 

[0035] To assist with calculating position data, the grating can include a variety of markers. For 
example, a marker can be placed at a comer of one of the gratings; a preferred marker is a Ught 
having a distinct color or wavelength. A processor 30, shown in FIGS. 4A and 4B, can then use 
the marker to determine the grating assembly orientation, e.g., which side of the grating 
assembly image supplied by the viewer is the top side. Where the viewer may have some trouble 
distinguishing the interference pattem generator from a cluttered background, the marker can 
also help the viewer locate the interference pattem. A person skilled in the art will appreciate 
that the interference pattem generator can also be distinguished base on its shape, illumination, 
color, other characteristics, and/or combinations thereof. 

[0036] One skilled in the art will appreciate that the grating assembly 10 can be scaled according 
to the intended use. For measuring very small movements, such as the movement of a person's 
skin in response to their heartbeat, the fiinge pattem interference generator might cover an area 
smaller than a postage stamp. In other applications, such as assisting with docking of large 
vessels (e.g., cargo ships) the fringe pattem interference generator could cover an area hundreds 
of feet across. 
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[0037] The image of the interference pattern is preferably captured by a viewer 20 capable of 
acquiring data representing an image containing the fringe pattem and supplying the data to a 
processor 30. In one embodiment, the viewer 20 is a camera which can acquire images, 
preferably digital, of the scene containing the interference pattem generator. The camera 
preferably has a large enough angular aperture to detect the interference pattem generator 
(target) over a large range of locations, and to has enough resolution to detect the shape of the 
target. The choice of camera will depend on the wavelength of the radiation which creates the 
interference fringes. Exemplary cameras include IR cameras and most standard, commercially 
available, video cameras. 

[0038] The processor 30 uses data from the viewer 20 to process the image of the grating 
assembly 10 and to obtain position data. The processor 30 preferably is capable of performing a 
variety of computations based on information from the viewer and information about the 
characteristics of the interference pattem generator. The calculations can include input from the 
viewer as well as stored information and/or information entered by a user. A person of skill in 
the art will appreciate that the processor can be a dedicated microprocessor or chip set or a 
general purpose computer incorporated into the object whose location is to be determined, or a 
similar but remote dedicated microprocessor or general purpose computer linked to viewer by 
wireless telemetry, 

[0039] FIGS. 4 A and 4B illustrates the grating assembly 10, camera 20, and processor 30. From 
position A shown in FIG. 4A, the camera 20 receives the interference pattem generated by the 
grating assembly 10. The processor 30 can then determine the relative position based on the 
image received. The relative position refers to position information based on the direction and 
distance from the grating assembly. If desired, the global position can then be determined based 
on the position of the grating assembly. As shown in FIG. 4B, the camera has moved to position 
B. Again, the processor can be used to determine the position of the camera with respect to the 
grating assembly. Altematively, the processor can track the movement of the camera from 
position A to position B based on the images received by the camera during transit. 

[0040] Although this example is given in terms of finding the position of the camera 20, the 
processor 30 can also calculate the relative position of a point in space or an object. For 
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example, the camera could be mounted on an object, such as a vehicle, and the processor could 
be used to determine the position and/or orientation of the object. The position of the object can 
be calculated by the processor directly, or stepwise based on the relative position of the grating 
assembly to the camera, and the camera to the object. 

[0041] The processor 30 can use the images it receives to determine position in several ways. In 
one embodiment, the processor determines the phase of the interference pattem, determines the 
number of fringes, and derives position data. Phase information is useful because as the viewer 
changes the angle with which it views the grating assembly, the interference pattem which it 
captures changes phase. Since the relationship between the change in phases and the viewing 
angle is known, the processor uses the phase information to help determine position. FIG. 5 
shows the grating assembly 10 with backlighting 14 and viewer 20 positioned at three different 
viewing angles (0). The three vertical fringe pattem images 40 illustrate exemplary fringe 
patterns corresponding to the three viewing positions of the viewer 20. Based on these images 
40, the processor 30 can find phase information and determine the angle (e.g., 9) at which the 
viewer is positioned relative to the grating assembly. Where the viewer and the grating assembly 
are positioned on different planes, the angle 9 is a measurement of the orientation of the viewer 
on the plane containing the viewer, which is parallel to the plane supporting the grating assembly 

[0042] In the case when the gratings are regular and identical, the phase of the interference 
fringe pattem is equal to 27c5/(X tan 9) + 2k7c, where d is the distance between gratings, X is the 
characteristic wavelength of the gratings, k is an unknown integer, and 6 is the phase angle or 
viewing angle. The unknown integer is a result of the fringe pattem cycling through several 
phases as the viewing angle varies from 0^ to 180^. Apart from the integer ambiguity, it is 
possible to obtain the viewing angle based on known information about the interference pattem 
generator and the phase of the interference pattem. 

[0043] In FIG. 5, the fHnge patterns 40 are shown as only having vertical fringes. An actual 
interference pattem would preferably have horizontal and vertical fringes so that a horizontal and 
vertical angle can be determined. Thus, by solving for the horizontal and vertical viewing angles 
the orientation of the viewer can be determined, up to an integer ambiguity, with respect to the 
grating assembly. 
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[0044] The interference pattern also allows the processor 30 to determine h, the distance between 
the viewer and the plane supported by the interference pattern generator. This distance can be 
found by determining the total number of fringes. Then with the known dimensions of the 
gratings, the wavelength of the fringes can be determined based upon the formula, wavelength = 
width of the grating / number of fringes. The variable h can then be solved for since the 
wavelength of the fringes is equal to WJd and X and d are known characteristics of the grating 
assembly. 

[0045] To find more exact position data and resolve the integer ambiguity, tracking of the phases 
of the interference fringes can be combined with an algorithm for eliminating nonsensical or 
unlikely choices. For example, standard maximum likelihood estimation algorithms can be used 
to lift the integer ambiguity and obtain precise positioning data. The idea is to combine high- 
accuracy (up to an integer ambiguity), relative position information provided by the fringes of 
the pattern generator with low-accuracy, absolute position information provided by a standard 
position estimation algorithm using only the geometrical features of the interference pattern 
generator and thereby resolve the integer ambiguity. A feature extraction algorithm based on the 
geometrical features of the interference pattern generator can recover and reorient the target 
(pattem interference generator), and obtain a low-resolution estimate on the position and 
orientation using stored information conceming the geometry of the target, the characteristics of 
the viewer, and data from the viewer. Exemplary stored information can include the dimensions 
of the target, e.g., rectangular with given edge lengths, and minimal information about the 
camera, e.g., the angular aperture of the camera. 

[0046] In one embodiment, an algorithm based on projective geometry, combined with a priori 
knowledge of the shape of the target and its dimensions, is used to obtain a rough estimate of the 
absolute position and orientation of the viewer with respect to the target. The position and 
orientation of the target with respect to the viewer can be summarized by a measurement 
consisting of a most likely estimate Pg,k=(xgk,ygk,hgk), along with a probability distribution around 
this most likely estimate. The coordinates Xgk and ygk are the planar coordinates of the viewer 
with respect to the target, and h is the distance to the plane supported by the target. Preferably, 
the uncertainty estimate is simplified in the form of a covariance matrix Cgk- In this notation, k 
designates the time step at which the camera captures the image. Using the rough position and 
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orientation information, the picture of the target (including interference fringes) is preferably 
"rectified", to provide an orthonormal view of the target. The process for rectifying an image of 
the target is discussed in detail below. 

[0047] Once the target is rectified, the fringes on the target can be more easily analyzed. The 
fringes appear as periodic pattern in two dimensions. Counting the number of fringes within the 
frame yields a new estimate of the altitude hfic of the target. Looking at the phase of the fringes 
(both horizontally and vertically) can yield a new estimate on the position of the viewer with 
respect to the target, up to an integer ambiguity. It can also help refine the orientation of the 
viewer with respect to the target. The most standard algorithms to perform this step are the 1-D 
and 2-D Fast Fourier Transforms (FFTs). 

[0048] This second step provides another, independent measurement of the position and 
orientation of the target; it can be summarized by a family of most likely estimates Pf,kj,i = 
(xfk+jl,yfk+il,hfk), on the position. The index k designates the time step at which the camera 
captures the image. The indices] and i are signed integer numbers and 1 the apparent wavelength 
of the interference pattern on the target, along with the same probability distribution centered on 
each most likely estimate, usually summarized by a covariance matrix C(Pf,k) (here it is assumed 
that 1 is the same in both dimensions, corresponding to equal grating wavelength in both 
dimensions). In addition, for each pair (j,i), we associate a positive probability pji for the 
corresponding candidate position Pf,kj,i to be the true position. Thus the sum over all indices i and 
j of the probabiUties py must be equal to one. 

[0049] Thus two sets of position data are available at all time steps k: First a set of absolute 

positions and covariances on positions (Pg,k, C(Pg,k)) obtained through direct processing of the 
target via projective geometry considerations, and a family of positions, covariances on positions 
and probabiUties (Pf,kj,i , C(Pf,k), Pji), obtained from processing the interference patterns from the 
target. 

[0050] The final position estimate can be determined by combining the measurements. In one 
embodiment, weighted averages can be used to determine a most likely position and orientation 
estimate Pk for the target along with its covariance C(Pk). This information can then be made 
available to the user. A person skilled in the art will appreciate that a variety of algorithms can 
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be used to obtain the most likely estimate, including, by way of non-limiting example, Bayesian 
and Kalman filtering techniques, and derivatives such as particle filtering, Wiener filtering, 
Belief networks, and in general any technique aimed at inferring high-precision information fi-om 
the optimal combination of a set of complementary observations. 

[0051] In an alternative embodiment, a different algorithm for determining position can be used. 
First and again, an algorithm based on projective geometry is used alone, combined with a priori 
knowledge of the shape of the target and its dimensions, to obtain a rough estimate of the 
absolute position and orientation of the viewer with respect to the target. The position and 
orientation of the target with respect to the viewer can be summarized by a measurement 
consisting of a most hkely estimate Pg,k=(xgk,ygk,hgk), along with a probability distribution around 
this most likely estimate. 

[0052] Second, the target can be rectified and the fringes on the target can be analyzed. This 
second step provides another, independent measurement of the position and orientation of the 
target; unlike the first exemplary algorithm, in this case we use the target as a very precise means 
to obtain velocity information on the potion of the viewer relative to the target (along with, again, 
an independent peasurement of distance h to the plane supported by the target), which we denote 
Vf.k = (vxfk,vyfk,hfic). The index k designates the time step at which the camera captures the 
image, vx and vy respectively denote the velocities along the two x- and;/- axes in the plane 
supported by the target. 

[0053] The two sets of complementary information are available at all time steps k: First a set of 
absolute positions and covariances on positions (Pg,k, C(Pg,k)) obtained through direct processing 
of the target via projective geometry considerations, and a set of velocities (with associated 
covariance) and vertical position, obtained by processing the interference patterns fi*om the 
target. 

[0054] The final position estimate can be determined by combining the measurements, using, for 
example, nonlinear filtering techniques. One such filter to obtain precise estimates on x and y 
could be constructed as follows: Let (xest,yest,hesi) be the estimated position in the plane supported 
by the target. 
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[0055] Initialize the estimated position by reading the position measurement Pg,o=(xgO,ygO,hgo); 
(Xest,o, yest,o,h€st.o) =(xgo,ygo,hgo). If (xgo,ygo,hgo) is unavailable, set (Xest,o, yest,o,h€st,o) =(0,0,0). 

[0056] Update the position estimate Xest,k+i := Xest.k + vxfk + Lx(k)(xgk- Xest,k) 

[0057] yest,k+i := yest.k + vyfk + Ly(k)(ygk- yest,k) 

[0058] hest,k+i = W + Lh,i(k)(hgk-hest.k) + Lh.2(k)(hflc - hest.k) 

[0059] Set k:=k+l and return to step 2) 

[0060] In this algorithm, the gains Lx(k), Ly(k), Lh.i(k) and Lh,2(k) are functions of time and 
allows the filter to weigh in the absolute (but noisy) position measurement obtained from the 
geometric position estimate into the overall position estimate. Typically these gains should be 
larger at the beginning of the algorithm, or when it needs to be reset, so that the position estimate 
quickly converge to the geometric position estimate. For large values of k, the value of the gains 
Lx(k), Ly(k), should then be decreased (but never set to zero), corresponding to a higher reliance 
on the velocity estimates obtained from the interference fringes. Other rules of thumb include 
using larger values of Lx(k), Ly(k), when the viewer is not facing the target (0 close to 0 or 180 
degrees) and using smaller values of Lx(k), Ly(k), when the viewer is facing the target (0 close 
to 90 degrees). Optimal values of Lx(k), Ly(k), Lh,i(k) and Lh,2(k) can be obtained by using 
Extended Kalman filtering techniques. 

[0061] FIGS. 6, 7, and 8 illustrate a square fringe pattem generator of known dimensions which 
appears as a rectangle because of the viewer's perspective. Rectifying the image of the fringe 
pattem interference generator provides a view of the interference pattem in actual dimensions on 
the horizontal plane. The following description exemplifies the procedure for (i) obtaining 
absolute position (and attitude) measurements (xgk,ygk,hgOk) and (ii) rectifying the fringe pattem 
generator. 

[0062] The position of the four comers of the target are fu-st identified in camera coordinates. 
One comer is assumed to be the origin and denoted in by 0. The position of the horizon line is 
then computed. The horizon line contain two points, the intersection of the first two parallel 
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edges of the camera target, and the intersection of the second two parallel edges of the camera 
target, denoted HI and H2 in FIG. 6. 

[0063] Next the location of the nadir is found. The nadir N is located on the center line passing 
through the center of the camera image and orthogonal to the horizon line. The nadir location is 
necessarily 90^ away from the horizon lines. Let f be the (known) focal length of the camera. 
Then, angular coordinates of any point P with coordinates x,y may be measured on the image 
plane, away from the center of the camera as follows: 

[0064] ap = atan ( sqrt(x^ + /) />0 (1) 

[0065] where 'sqrt' is the square-root function. Let H=(xh, yh) be the intersection of the horizon 
line with the center line. The corresponding angular coordinate is 

[0066] a // = atan ( sqrt(x/2^ + yh^) /J) (2) 

[0067] Then the position of the nadir N, (xn, yn) in the figure coordinates is 

[0068] {xn, yn)= (xh, yh)ft^n(a h - nil)/ sqrt(x/2^ -^yh^)^ (3) 

[0069] The line LI going from N to HI is parallel to that going from 0 to HI in three dimensions 
and the line L2 going from N to H2 is parallel to that going from 0 to H2 in three dimensions. In 
addition, these lines are orthogonal to each other (in three dimensions). Thus measuring the 
three dimensional distance from L2 to L2' gives the y coordinate of the viewer. Let Al' be the 
intersection of the center line with the line passing through Al and parallel to the horizon line. 
From (1), the angular position of A 1' is 

[0070] uav = atan ( sqrt(x^i.^ ^-yAv) If) (4) 
[0071] Thus the distance of Al from the Nadir N is /z zoM^-Uav + Qh) 

[0072] Consider now PI, the intersection of a Une parallel to the horizon line going through the 
center of the picture with LI. From (1) the angular coordinate of PI is 

[0073] apx= atan ( sqrt(jc/.,' + yp^ Ij) (5) 
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[0074] We now compute the position of PI on the plane supported by the target. The projection 
of the center of the image to that plane is located at a distance 

[0075] d = h/smaH (6) 

[0076] from the camera. The point PI is located at a distance dtmapx from the projection of 
the center of the camera onto the plane supported by the target. The distance from the nadir to 
the projection of the center of the camera onto the plane supported by the target is d cos a h- 

[0077] Thus the angle P of the line from the nadir to point PI with the line from the nadir to the 
projection of the center of the image to the plane supported by the target is given by 

[0078] tm^ = d tan ap\/( d cos an )= tan ap\/ cos an (7) 

[0079] Remember the distance form the Nadir to the point Al ' is 

[0080] h coti-aAv + cch^ (8) 

[0081] we finally get the distance from the nadir toA\ as 

[0082] yc = h cot(-a:^r + a ^) / cos /?. (9) 
[0083] and this is one of the coordinates sought, 

[0084] Because of the rectangular shape of the target, the line going from the nadir to A2Ms at 
an angle n/2 - P from the line from the nadir to the projection of the center of the image onto the 
plane supported by the target. Thus the distance xc from the nadir to A2 is 

[0085] xc = h cot{-aA2' + / sin J3, (10) 
[0086] where 

[0087] a AT = atan ( sqrt(x^2«^ +>^^2'^) //). (1 1) 

[0088] Thus we now have the sought coordinates xc and yc, up to the imknown height h. To get 
this height, we can perfomi exactly the same operation to compute the distance (xc',yc') from 
the nadir to the points Bl and B2, respectively. For example, 
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[00891 xc' = h cot(-a bi- + «//)/ sin fi. 



(12) 



[00901 where 



[00911 a^. = atan ( sqrt(xB2.^ +>'fi2'^) //)• 



(13) 



[00921 Using the known relationship 



(00931 xc' = xc + L 



(14) 



[00941 where L is the length of the side of the target, we get 



[00951 h cot(-aB2' + cch)/ sin fi-h cot(-a^2* + cch)/ sin fi= L, 



(15) 



[00961 or 



[00971 /i = i, sin/?/ (cot(-a 52'+ or//) - cot(-a^2' + «//)). 



(16) 



[0098] Thus we now have all the desired information. Absolute position measurements are 
obtained by setting: Xgk= xc, ygk=yCj hgk=h 

[0099] These equations can be used to correct the orientation of the reference target image to that 
it is viewed in actual dimensions on the horizontal plane. This makes it easy to pick the Fourier 
transform of the interference image to obtain high resolution information on relative position 



[00100] Position data can also be calculated without the step of rectifying the image. Although 
the image of the interference pattern generator may be skewed by the viewer's perspective, the 
viewer can still use the image to determine relative position. 

[00101] The high resolution positioning information provided by the present invention can be 
used in a variety ways, including by way of non-limiting example, navigating, docking, tracking, 
and measuring. For example, the system can be used inside a warehouse to track packages as 
they move between locations, to assist with alignment during docking, and/or to guide automated 
machinery. In a laboratory, the present invention could provide inexpensive, but accurate 
measurements for conducting experiments. Other possible uses may include medical monitoring 



changes. 
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and tracking. For example, an interference pattern generator could be placed on a patient to 
monitor breathing and/or heartbeat. Another medical example would include using the present 
invention to monitor patient movement during dehcate surgery, such as, brain surgery. If the 
patient were to move, the highly accurate positioning system of the present invention could alert 
doctors and/or provide a surgeon with guidance for making adjustments. A person skilled in the 
art will appreciate that the present invention can be used to perform a variety of functions in a 
variety of industries. 

[00102] A person skilled in the art will also appreciate that the foregoing is only illustrative of 
the principles of the invention, and that various modifications can be made by those skilled in the 
art without departing from the scope and spirit of the invention. All references cited herein are 
expressly incorporated by reference in their entirety. 
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